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1.  INTRODUCTION 


Connected  multi-body  dynamics  problems  of  all  kinds  have  been 
encountered  since  the  invention  of  the  wheel  and  its  application  to  a  moving 
platform.  The  precise  formulation  of  the  equations  of  motion  for  more  than  two 
connected  bodies  brought  little  attention,  except  for  the  compound  pendulum, 
until  the  space  age,  probably  because  techniques  and  means  for  the  solution  to 
the  equations  for  two  bodies  with  more  than  one  or  two  degrees  of  freedom  were 
generally  unavailable  or  too  unwieldy  and  impractical  to  use.  In  the  last  two 
decades,  tremendous  advances  have  been  made  in  both  the  formulation  methods 
and  computer  solution  to  multi-body/multi-degree  of  freedom  problems.  Today, 
it  is  not  uncommon  to  obtain  computer  solutions  for  multi-body  systems 
including  flexible  modes  with  more  than  twenty  degrees  of  freedom  or  more  than 
fifty  state  variables.  Even  so,  such  computer  programs  evolve  to  usefulness 
only  after  the  problem  equations  formulation,  computer  coding  of  the 
equations,  and  debugging  of  the  problem.  The  general  effectiveness  of  the 
resulting  multi-body  dynamics  and  control  simulation  is  usually  assessed  in 
terms  of  the  formulation  and  coding  and  debugging  effort,  the  computer  run 
time,  the  ease  of  an  analyst  to  become  familiar  with  the  program  after  it  has 
been  developed,  and  the  ease  of  modifying  the  program  to  reflect  changes  and 
additions  to  the  design  of  the  system.  With  these  ideas  in  mind,  the  multi¬ 
body  dynamics  formulation  for  a  spaceborne  gimbal  system  was  undertaken  anew. 

The  approach  initially  favored  was  one  wherein  the  "primitive"^ *'* 
Newtonian/Eulerian  equations  for  translational  and  rotational  motion  are 
retained  throughout.  This  would  have  required  retention  of  all  6  degrees  of 
freedom  for  each  body  and  the  necessity  of  integrating  more  state  variable 
equations  than  are  actually  needed.  Because  computer  run  time  is  roughly 
proportional  to  the  number  of  state  variables  and  to  the  highest  frequency 


We  use  Jerkovsky's  definition:  By  "primitive"  equations  and  variables,  we 
mean  equations  and  variables  that  refer  to  each  body  as  a  separate  and  dis¬ 
tinct  body  without  regard  to  how  it  fits  into  the  multi-body  configuration. 


mode  in  the  system,  we  can  reduce  run  time  considerably  by  reducing  the 
degrees  of  freedoo  of  each  body  to  3  by  not  solving  the  translational 
equations  of  motion  by  integration.  However,  holonomic  constraint  equations, 
which  are  essentially  algebraic,  that  constrain  the  gimbal  geometry  to  con¬ 
serve  translational  momentum  of  the  gimbal  system,  have  been  introduced  in 
this  paper  which  supplant  the  translational  differential  equations  of 
motion.  This  is  basically  the  approach  initially  taken  by  Russell^^  in  his 
so-called  "primed  momentum"  formulation  method.  We  are  then  left  with  3  ' 
rotational  degrees  of  freedom  for  each  body  which  are  permitted  for  each  axis 
of  a  Cartesian  coordinate  frame  associated  with  that  body.  The  Cartesian 
reference  frames  are  retained  from  the  beginning  in  order  to  permit  insight, 
visibility,  and  a  feel  for  what  is  dynamically  happening  throughout  the 
formulation  and  simulation.  Generalized  coordinates  formulations  such  as  are 
used  in  Lagrange,  D'Alembert,  Hamilton  Boltzmann-Hamel,  Gibbs,  and  Kane^^ 
derivations  of  the  equations  of  motion  are  avoided  on  purpose  as  is  the 
transformation  operator  formalism  of  Jerkovsky.^1’^  This  is  because  a) 
insight  seems  to  get  lost,  and  b)  either  hand  reduction  by  matrix  Inversion  of 
the  constraint  equations  to  reduce  computer  solution  time  is  needed,  or  this 
problem  is  left  to  the  computer  whereby  run  time  suffers  due  to  matrix 
inversions  that  are  performed  in  each  integration  step.  These  other 
approaches  admittedly  have  the  potential  of  shorter  computer  run  times  than 
are  obtained  using  a  momentum  formulation  because  they  reduce  the  number  of 
degrees  of  freedom  for  each  body  to  an  absolute  minimum,  e.g.,  the  equations 
for  a  single  bearing  axis  gimballed  body  only  needs  one  degree  of  "free” 
rotational  freedom,  the  other  two  degrees  of  relative  freedom  being  "hard" 
constrained  or  completely  nulled  via  constraint  equations. 

In  the  alternative  approach  taken  here,  relative  motion  about  the 
constrained  motion  a«as  of  the  Cartesian  frames  is  permitted,  but  only 
slightly.  The  small  to  infinitesimal  relative  motions  allowed  require 
additional  solutions  of  angular  motions  transverse  to  the  bearing  axis  but  tie 
eliminate  the  need  for  hand  or  computer  solution  of  "hard”  constraint 
equations  which  generally  involve  matrix  inversions.  An  advantage  obtained  is 
that  the  true  transverse  axis  dynamics  can  be  revealed  and  their  effect  on 
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system  stability  evaluated.  However,  because  girobal  bearing  transverse  axis 
stiffnesses  can  be  large,  the  highest  associated  eigenvalue  frequency  can  be 
considerably  higher  than  the  highest  control  loop  component  bandwidth  thereby 
requiring  shortening  of  the  integration  step  size  merely  to  get  the  constraint 
satisfied.  This  shortcoming  can  be  alleviated  after  one  ascertains  that  high 
frequency  mode  instability  is  not  a  problem  by  artificially  reducing 
transverse  axis  stiffness  or  increasing  transverse  axis  viscous  friction  in  a 
way  that  lowers  the  transverse  axis  characteristic  frequency  to  the  vicinity 
of  the  control  loop  bandwidths. 

The  multi-body  equations  presented  in  this  paper  are  derived  for  bodies 
in  an  open  chain  tree^^  configuration  typical  of  a  spacecraft  with  two  or 
more  gimballed  elements.  The  rotational  equations  of  motion  of  one  of  the 
bodies  are  general  for  open  chain  tree  configurations  as  are  the  translational 
momentum  constraint  equations.  The  equations  and  matrix-scalar  block  diagrams 
are  given  for  an  example  4-body  system  comprised  of  a  3  axis  controlled 
spacecraft,  a  single  axis  controlled  solar  array,  and  a  2-axis  gimbal  con¬ 
trolled  payload  with  a  gimbal  yoke  that  has  mass  and  inertia. 


2.  GIMBALLED  BODY  MOMENTUM 


Referring  to  Figure  1,  we  Imagine  the  glmballed  body  with  a  mass  element 
dm  at  R  relative  to  an  Inertial  frame  I  to  be  glmballed  about  one  of  the  axes 
of  a  frame  G  whose  basis  vectors  are  parallel  to  those  of  frame  g  at  the  c.m. 
of  the  body.  Frame  g  Is  displaced  an  amount  r^  from  the  frame  G  and  both 
frames  are  fixed  in  the  body  and  therefore  rotate  with  the  body  at  its 
inertial  angular  rate  u.  Then  the  moment  of  momentum  of  this  body  about  the 
origin  of  the  frame  g,  or  in  other  words,  about  its  center  of  mass  is^-®^ 


-*■  ,  +  + 

H  •  J  r  x  R  dm 
8 


(1) 


► 

r  x 


(Rt  +  m  x  r)dm 


(2) 


H 


,  ,  •* 

J  r  x(u>  x  r)dm  -  R £  x  J  rdm 


(3) 


The  first  term  on  the  right  side  of  (3)  is  I  •  u  where  I  is  the 
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inertia  dyadic  or  inertia  matrix  with  respect  to  the  frame  g,  and  the  integral 
in  the  second  term  is  equal  to  the  glmballed  body  mass  M  times  the  radius 
vector  from  the  frame  g  to  the  c.m.  which  is  the  null  vector  and  hence  is 
zero.  Thus  (3)  is  written  as 


3.  EQUATIONS  OF  MOTION 


The  equation  of  translational  motion  for  the  gimballed  body  of  Figure  1 


MlRi  =  Fi  “  F( i— 1 ) 

In  the  figure,  we  have  assumed  two  gimhal  points  on  the  itt'  body.  The 
subscript  _i_  identifies  the  gimbal  frame  associated  with  that  body  and  the 
interbody  force  and  torque  at  that  point,  whereas  the  subscript  (i  -  1) 
identifies  the  adjacent  connected  body  and  its  associated  gimbal  that  it 
shares  with  the  i1-*1  body  and  its  interbody  force  and  torque.  The  negative  of 
the  interbody  force  and  torque  acting  on  the  (i  -  1)  body  are  felt  by  reaction 


on  the  l' 


body . 


The  equation  of  rotational  motion  about  the  point  g,  or  center  of  mass 
of  the  body  is^-^ 


*T  - 


where 


T  -  T 

i  (i-D 


(ri  *  Fi> 


*(«,) 


(8) 


where  the  last  expression  has  been  introduced  for  convenience  in  simplifying 
the  form  of  the  resulting  equations.  In  the  usual  approach  we  would  substi¬ 
tute  appropriate  combinations  of  (5)  into  (8)  which  process  is  lengthy  and 
replete  with  terms.  To  show  the  general  idea  of  the  equation  development,  we 
further  simplify  by  Introducing 
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(9) 


so  that 


rQ  X  FQ  "  CQ  *  MQRQ 


Following  the  concept  introduced  by  Russell^)  we  write  (10)  as 


♦  d  ,*■  ♦  +  ♦ 

r  x  F  ■  — (rxMR)-rxMR  ill! 

Q  Q  dt'  Q  Q  Q  Q  Q  '  ; 

Employing  (11)  in  (6)  we  have 

•  •  •  • 

?T  ■  5g  *  *  «QSQ>  -  h  x  Vo  <12> 

The  vector  derivatives  indicated  in  (12)  are  relative  to  an  inertial 

reference.  In  order  to  solve  a  vector  differential  equation  computationally, 

It  needs  to  be  scalarlzed  in  a  convenient  frame  of  reference  (see  Appendix). 

We  wish  to  use  Che  frame  C  in  our  computations  and  so  we  find  the  components 

of  the  inertial  vector  derivatives  of  H  and  r.  which  have  their  bases  in  that 

g  Q 

rotating  frame.  Using  Appendix  formula  (A-15)  and  scalar  component  matrix 
notat ion. 


H=H+wxu 
gl  gG  G  gG 


r  =*  r  +  u  x  r 
QI  QG  G  QG 


Because  the  position  vectors  in  (8)  are  fixed  in  the  body  fixed  frame 

G,  r__  =  0. 

QG 

The  vectors  $T  and  may  have  been  originally  known  and  expressed  in 
terms  of  their  components  in  an  Inertial  frame  I,  however  their  components  in 
the  C  frame  are  straightforwardly  obtained  by  transforming  the  vector 
components  from  the  inertial  frame  I  to  the  gimbal  frame  G  as  required,  e.g., 


12 


(15) 
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and 


Tp  -  <“  x  rQ>  *  Vq  <21> 

The  quantity  Hp(,  is  defined  as  Russell’s^2)  "primed"  angular  momentum, 
which  Includes  the  momentum  H  due  to  rotation  about  the  center  of  mass  plus  a 
term  resulting  from  the  translational  motion  of  the  body  center  of  mass  due 
to  gimballlng.  The  term  is  referred  to  as  the  "swing”  momentum. 

The  terra  Tn  in  (18)  is  a  torque  that  is  related  to  the  acceleration 

__  _  X 

term  (WG  x  rqG)  x  RqG  a°d  referred  to  as  the  "swing”  torque.  The  swing 
torque  and  the  time  derivative  of  the  swing  momentum  comprise  the  interbody 
torque,  i.e.,  the  net  torque  acting  on  the  1th  body  due  to  motion  of  the 
ensemble  of  bodies. 

Equations  (18)  and  (19)  are  the  equations  describing  the  angular  motion 

of  one  of  the  glmballed  bodies  in  a  multi-body  system.  The  solution  to  these 

equations  is  depicted  in  block  diagram  form  in  Figure  2  where  T^,,  T^  and 

are  regarded  as  independent  variable  inputs  in  the  figure  and  the  computed 

components  w  of  u  in  the  gimbal  frame  G  are  the  output.  The  inverse  I  *  of 
G  8 
the  inertia  matrix  I  which  is  determined  relative  to  the  frame  g  is  a  physi- 

8  _ 

cl  parameter  as  are  the  mass  M  and  the  components  of  r  in  the  gimbal  frame. 
Equations  (18)  and  (19)  further  simplify  to  familiar  forms  if  r^  «  0  or  if 
R ■  0  which  makes  the  center  of  mass  inert tally  fixed.  The  terms  H  $nd  Tn 
generally  will  not  be  zero  in  a  multi-body  system  and  the  presence  of  R^  which 
is  related  to  the  glmballed  mass  velocity  contributes  in  some  cases  very  sig¬ 
nificantly  to  the  angular  momentum  of  the  body  and  therefore  is  very  important 
to  consider.  Its  effect  is  amplified  by  the  vector  r^  which  is  related  to  the 
distance  from  the  gimbal  points  to  the  center  of  mass  of  the  body. 
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Single  Gimballed  Body  Equation  of  Motion 


4.  FOUR  BODY  SYSTEM  DYNAMICS 


The  translational  equations  of  motion  given  by  (5)  are  written  out,  for 
example,  for  the  four  body  chain  configuration  shown  In  Figure  3, 


*4  + 

M1R1  *  F1 


(22) 


'4  +• 

M2r2  =  F2  -  Ft 


(23) 


*4  >  + 

M3R3  "  F3  "  F2 


(24) 


*4  + 

M4R4  “  -F3 


(25) 


4.1  INTERBODY  TORQUES 

The  Interbody  torques  resulting  from  interbody  forces  are  now 
determined.  It  Is  easily  seen  that  equations  (8)  and  (5)  or  equations  (22-25) 
yield  for  the  Ith  body  in  the  chain 


rQt  *  V  •  'i x  - '  *ix  £  \\ 


V  .  (fcl)  V 

ri x  Vi  -  P1 x  £  \\ 

k-1 


d 

It 


*  4  ♦  (i^D  4  ] 

rl  X  MiRt  -  Pi  X  £  Vkj 

4  V  V  (tP  4  1 

r,  «  MR  -  P,  «  £  \\\ 

k-1  ■» 


(26) 
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1 


where 
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which  becomes  after  scalar! zing  to  the  i1*1  gimbal  frame, 


_  i  (i-D  ^ 

roi  "  (“i  x  ri)  x  MiRi  ~  (“i  x  pt>  x  £  MkCkRk 
^  k“l 


(35) 


For  the  four-body  system  of  Figure  3,  the  swing  torques  on  each  body  are 
found  to  be 


X  rx)  X 
X  X 

X  r3)  X 


M!R! 


M2R2 


M3R3 


(“2  x  P2)  x 

(“3  x  P3>  x  (M^3  •  +  M2C^  •  R2) 


or 


(36) 

(37) 

(38) 


TQ3  “  (W3  X  r3}  X  M3R3  "  (<°3  X  P*3)  X  HA  *  R4  (39) 

V  =  <“4  X  V  X  M4^4  <40> 

• 

We  can  now  proceed  with  the  determination  of  the  R^  terms  in  (28)  in 
order  to  calculate  the  solution  of  equations  (18)  and  (19)  shown  in  Figure 
2.  In  the  material  that  follows,  the  subscripts  denote  the  mass  and  gimbal 
numbers.  The  subscript  G  has  been  suppressed  and  replaced  merely  with  the 
gimbal  number  1.  The  total  torque  on  body  i  will  be  found  to  be  comprised 
of  the  torque  from  the  1th  gimbal  elements  (torque  motor,  bearing  friction, 
etc.)  plus  the  reaction  torque  from  the  (i-l)**1  gimbal  elements. 


4.2  MOMENTUM  -  KINEMATIC  CONSTRAINTS 

Figure  3  schematically  shows  several  bodies  connected  together.  A  main 
body  is  shown  which  could  be  the  main  part  of  a  spacecraft  which  has  a  gimbal 
system  that  points  a  payload,  e.g.,  the  main  body  M3  could  be  the  spacecraft, 
M^  its  solar  array,  M2  a  gimbal,  and  M1  the  payload.  The  axes  and  G2  would 


20 


then  be  the  payload  gimbal  axes  and  Gj  the  solar  array  gimbal  axis.  In  the 
following  analysis,  the  subscript  number  denotes  the  gimbal  frame  number  and 
the  associated  gimballed  body  number.  Refer  to  the  appendix  for  definitions 
of  vectors,  scalars,  matrix-scalar  expressions  and  transformations. 

It  is  obvious  that  the  gimbal  points  move,  i.e.,  the  change  as  the 
gimballed  bodies  are  articulated.  We  now  proceed  to  find  the 

The  center  of  mass  of  the  system  is  chosen  as  the  origin  of  the 
inertially  fixed  reference  frame  corresponding  to  the  Xj  Yj  Zj  frame  in  Figure 
1.  This  restricts  the  analysis  in  this  paper  to  the  situation  of  no  external 
forces  that  would  cause  the  system  c.m.  to  undergo  translational  motion.  Pure 
moments  about  the  system  c.m.  would  be  permissible.  The  definition  of  the 
center  of  mass  is  employed;  i.e., 


L  MR  -  0  (41) 

i-1  1  1 


If  we  differentiate  (41)  we  get 
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which  is  a  statement  of  the  conservation  of  translational  momentum  of  the 
system.  Referring  to  Figure  3,  the  following  vector  relations  are  found: 
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In  general,  for  the  chain  configuration 


(43) 


Also, 


where 

P2  =  vector  from  G^  to  G2,  etc. 
so  in  general 


0(1-1) 


(44) 


or 


i 

+  r 

k-2 


(45) 


Equations  (43)  and  (44)  are  depicted  in  Figures  1  and  3.  Differentiating 
(43),  we  get  for  the  Ith  body 
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Oi 


+  w  x  r, 


(46) 


An  x  r  )  term  is  not  present  because  vector  is  not  based  in  the  1th 
body  moving/ rotating  coordinate  frame  but  rather  is  based  in  the  inertial 
frame  centered  at  the  system  c.m.  On  the  other  hand,  the  r^  vector  is  based 
and  fixed  In  the  ltfl  body  frame  so  that  its  time  derivative  is  identically 
zero  and  the  (w^  x  )  term  arises  from  the  angular  rate  of  the  it*1 
body.  Similarly,  differentiating  (44)  and  (45)  we  get 


R0(i-1) 
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and 
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Substituting  (48)  Into  (46)  and  the  result  into  (42)  we  obtain 


(48) 
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which  can  also  be  expressed  as 
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The  vectors  in  (50)  should  be  expressed  in  terms  of  their  components  in  the 
same  coordinate  frame.  Thus,  we  scalarlze  (50) 
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where  we  have  arbitrarily  chosen  the  first  body  as  the  computational  coordinate 

frame  and  the  transformation  matrices  C  j  are  employed  to  transform  the  vectors 

u  ,  r.  and  p.  expressed  in  the  1th  body  coordinates,  back  to  the  first  body 
ill  • 

coordinates.  As  an  example,  for  4-bodles  in  series  (51)  is  used  to  find  If  . 
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-«01  *  "l(“l  X  'l>  +  M252  -<“2  X  r2> 

+  «J&  -(“3  x  T3>  +  HA  -<“i  -  '*> 

+  (M2  +  M3  +  M4)C2  *(«2  *  P2) 

,1  -  -  (52) 

+  <M3  +  M4)C3  *(U)3  X  P3) 

(The  P"  and  P~4  terms  are  noted  to  be  zero*)  After  is  computed,  the 
remaining  R  needed  to  complete  the  solution  for  the  constraints  are  found 

vl  • 

from  (47).  These  are  needed  In  the  solution  of  the  equations  for  momentum 
and  motion  which  are  computationally  performed  in  each  of  the  gimballed  bodies 
respective  coordinate  frames  and  so  they  are  scalar ized  in  the  ith  frame. 

From  (46),  and  (47)  we  obtain  the  scalarized  result 


E1 

C(i-1> 
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O(i-l)  i 
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(53) 


and  from  (46)  and  (4ft) 
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i 
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(54) 


Equation  (53)  is  obviously  simpler  than  (54)  and  so  it  is  the  preferred  method 
of  calculating  the  If  (i.e.,  in  succession). 
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5.  ROTATIONAL  MOTION  RESTRAINT  EQUATIONS 


The  solution  of  the  equations  of  motion  of  a  single  body  In  the  ensemble 
of  bodies  as  depicted  In  Figure  2  can  be  carried  out  as  previously  noted  using 
equations  (18),  (19),  (28),  (35),  (51)  and  (53)  yielding  the  body  angular 
rates.  The  incremental  angular  motions  that  can  be  obtained  by  integration  of 
the  body  angular  rates,  accounting  for  kinematics,  are  those  angular  motions 
about  the  gimballed  it*1  body  axes.  Practically  speaking,  for  glmbal  motion 
freedom,  one  axis  is  unrestrained  in  the  sense  that  large  relative  angular 
motion  may  occur  (about  the  gimbal  bearing  axis)  between  the  gimballed  body 
and  the  neighboring  body  to  which  it  is  attached.  The  other  two  body  axis 
motions  relative  to  the  attached  body  are  restrained  by  the  bearings  to  be 
small  or  near  zero.  One  approach  in  writing  simulation  equations  is  to  assume 
these  transverse  gimbal  axes  motions  to  be  zero.  This  requires  that  "hard” 
constraint  relations  be  solved  algebraically  in  each  integration  step  of  the 
simulation.  The  analytical  determination  of  the  hard  constraint  relations  is 
avoided  in  the  approach  taken  here.  Instead,  the  constraints  for  the  bearing 
transverse  axes  are  implemented  by  feeding  back  reaction  torques  about  these 
axes  that  are  proportional  to  small  relative  transverse  axes  angular 
motions.  In  effect  then,  the  constraint  relations  appear  as  restraint  gimbal 
stiffnesses.  In  fact,  the  stiffnesses  used  in  the  simulation  can  be 
actual  bearing  transverse  axes  stiffnesses  or  perhaps  the  stiffness** 
associated  with  the  lowest  frequency  modes  of  vibration  about  these  axes. 

One  can  take  the  point  of  view  that  the  so-called  unrestrained  axis  or 
the  bearing  "free”  axis  is  also  restrained  by  the  reaction  and  control  torques 
relations  for  that  axis.  These  torques  include,  for  example,  motor 
electromagnetic  torque,  motor  cogging  torque,  motor  magnetic  hysteresis 
torque,  bearing  and  motor  solid  friction  torque,  and  viscous  friction  torque. 

With  these  notions  then,  the  transverse  axes  motions  that  would  be 
oscillatory  with  stiffness  feedback  only,  can  also  be  dampened  using  realistic 
structural  damping  relations.  If  the  simulation  is  expected  to  give  good 
fidelity  response  data  at  the  usually  higher  structural  frequencies,  the 


damping  introduced  should  be  realistic.  If  the  simulation  is  not  expected  to 
provide  high  fidelity  results  except  at  frequencies  well  below  the  structural 
frequencies,  it  is  anticipated  that  high  damping  can  be  artificially  intro¬ 
duced  for  the  bearing  transverse  axis  modes.  This  will  allow  the  use  of 
larger  integration  step  sizes  in  a  digital  simulation  and  consequently  will  be 
more  economical  in  computer  run  time.  The  restrained  body  dynamics  equations 
are  shown  for  the  i11*1  body  in  block  diagram  form  in  Figure  5. 


6.  FOUR  BODY  SKRVO  SYSTEM  EXAMPLE 


6.1  CTMBALS /COORDINATES 

An  example  of  a  multi-body  gimbal  servo  system  Is  Illustrated  in  Figure 
6.  A  block  diagram  of  the  "complete"  dynamics  equations  for  this  example  is 
shown  in  Figure  7. 

The  first  body  is  the  pointed  experiment  payload  of  mass  which  has  a 
gimbal  coordinate  frame  X^ ,  Y^ ,  fixed  in  the  payload  with  Zj  along  the 
line-of-sight  of  the  experiment,  is  the  cross-track  gimbal  axis,  and  Y^ 
completes  the  triad.  The  center  of  mass  of  is  offset  from  the  G^  gimbal 
center  an  amount  r^. 

The  second  body  with  mass  Mj  is  the  gimbal  yoke.  The  yoke  gimbal  center 
point  G2  is  assumed  to  be  midway  between  the  cantilevered  yoke  bearings  that 
provide  free  rotation  of  the  yoke  about  the  Y2  axis.  The  yoke  X2  axis  moves 
with  the  yoke  and  is  parallel  to  the  experiment  gimbal  axis.  The  Z2  axis 
completes  the  yoke  orthogonal  frame.  The  center  of  mass  of  the  yoke  is  offset 
from  the  G2  gimbal  point  an  amount  r^. 

The  third  body  is  the  spacecraft  and  its  gimbal  frame  G^  is  arbitrarily 
assigned  to  the  same  point  as  the  solar  array  frame,  G^,  i.e.,  it  could  also 
have  been  assigned  to  the  same  point  as  the  yoke  frame  point  G2.  As  shown  in 
figures  4  and  6,  the  G^  and  G^  points  coincide.  The  spacecraft  Y3  axis  is 
parallel  to  the  yoke  Yj  axis  and  coincides  with  the  solar  array  Y^  axis.  The 
spacecraft  Xj  axis  is  fixed  in  the  spacecraft  parallel  to  one  of  its  edges  and 
also  nominally  parallel  t<>  the  spacecraft  orbital  velocity  vector.  The  Z^ 
axis  points  in  the  direction  of  orbit  nadir  and  completes  the  right  handed 
triad. 

The  solar  array  axis  is  parallel  to  an  edge  of  the  array  which  is 
maintained  normal  to  the  sun  line.  The  Z4  axis  completes  the  array  frame  G^ 
triad. 


Figure  7.  Simulation  Model  foe  a  Spacecraft  With  Gimballed  Experiment 
and  Solar  Array 
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6.2  CONSTRAINTS  AND  RESTRAINTS 

The  constraint  relations  in  Figure  4  apply  to  this  example  and  in  effect 
maintain  the  glmbal  points  geometry  so  that  the  distances  between  gimbals  are 
maintained  constant  (e.g.,  p *  vector  from  g^  to  g2  ”  constant). 

The  "restraint"  provisions  that  keep  the  angular  rotation  about  the 
gimbal  transverse  axis  small  are  the  realistic  stiffnesses  about  the 
experiment  Y|  and  Z^  axes,  the  yoke  X2  and  Z2  axes,  and  the  solar  array  X^  and 
Z^  axes.  The  stiffnesses  enter  into  the  equations  of  restrained  motion;  for 
example,  as  indicated  in  Figure  S  for  the  i^1  body,  and  Figure  8  for  the 
complete  system,  in  the  blocks  labeled  which  are  3  *  3  stiffness 

matrices.  The  diagonal  elements  are  the  stiffnesses  about  the  X2,  Y2 ,  Z2 
axes.  The  off-diagonal  elements  are  assumed  to  be  negligible.  Since  the  yoke 
Y2  axis  is  unrestrained  except  for  solid  friction,  its  stiffness  is  zero  or 
small  compared  to  the  X2  and  Z2  stiffness  elements  in  Kj.  Data  for  the 
stiffness  elements  can  be  obtained  from  design  data  or  test  data. 

The  other  restraint  provisions  are  applied  somewhat  realistically  such 
as  viscous  friction  in  all  axes  in  the  B^,  3  *  3,  matrix  in  Figure  5.  The 
diagonal  elements  are  the  viscous  friction  coefficients  operating  on  the  X2> 
Y2,  Z2  relative  angular  velocities.  The  off-diagonal  terms  are  assumed  negli¬ 
gible.  The  controlled  Y2  axis  viscous  friction  coefficient  can  be  found  from 
test  data.  The  X2  and  Z2  axis  friction  coefficients  can  be  assigned  values 
that  make  the  roots  of  the  characteristic  equation  of  the  I2  -1K2/S4  + 

loops  taken  together  for  the  X2  and  Z2  channels  overdamped  such  that 
the  low  frequency  root  is  not  much  higher  than  the  Y2  control  bandwidth  (say 
for  the  rate  control  mode).  If  the  undamped  roots  of  the  aforementioned 
characteristic  equation  lie  within  the  control  bandwidth,  then  an  attempt 
should  be  made  to  use  as  realistic  a  friction  model  as  possible  for  the  trans¬ 
verse  axes.  Some  viscous  friction  may  be  present  for  transverse  axis  motion 
of  the  glmbal  axis  relative  to  the  adjacent  spacecraft  body  through  the  action 
of  lubrication  as  the  viscous  mgtfl'a.  Perhaps  a  better  choice  of  a  model  for 
incorporating  damping  is  to  use  a  simplified  solid  friction  model^^  that 
results  in  realistic  solid  friction  hysteretic  damping.  The  model  is  an 
integral  function  of  the  relative  angular  rate  Aw^  given  by 
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(55) 


where  Tpj  is  the  j  axis  component  of  solid  friction  torque  that  retards  the 
motion,  is  the  solid  friction  model  rest  slope,  and  TCj  is  the  coulomb 
friction  torque  level.  Even  though  it  is  hysteretic,  the  model  behaves  like 
viscous  friction  for  medium  amplitudes  of  angular  oscillatory  motion  but  the 
behavior  transitions  to  non-linear  "structural  damping"  for  very  low  ampli¬ 
tudes  of  oscillation.  Structural  damping  virtually  disappears  near  zero 
amplitude  motion. 

6.3  CONTROLLED  AXES 

The  controlled  gimbal  axes  are  the  experiment  X^  axis,  the  yoke  Y2  axis, 
and  the  solar  array  axis. 

6.4  SENSORS 

Rebalance  rate  gyros  (in  Gj  and  G2  of  Figure  7)  are  mounted  with  input 
axes  along  the  X1  and  Y2  axes  and  sense  the  Inertial  angular  rates  of  the 
experiment  and  yoke  about  these  axes.  Angle  pickoffs  (in  and  of  Figure 

7)  are  also  mounted  on  these  axes  and  measure  the  relative  Euler  angles 
12 

$2>  A  sun  sensor  (in  P^,)  is  mounted  on  the  solar  array  and  measures  the 

angle  between  the  sun  vector  and  the  Y^  plane.  An  earth-sensor  (in  ?3) 
looks  at  the  earth  in  the  Z3  direction  and  measures  spacecraft  pitch  (about 
Y3)  and  roll  (about  X3)  attitude  errors.  The  spacecraft  attitude  control 
system  also  has  rebalance  rate  gyros  (in  G3)  and  a  star  sensor  mounted  on  the 
spacecraft  body  (not  shown  in  Figure  7). 

6.5  ACTUATORS 

The  controlled  gimbal  axes  are  driven  relative  to  the  adjacent  body  by 
reacting  against  the  adjacent  body  with  D.C.  torque  motors.  The  spacecraft 
primary  attitude  control  mode  during  experiment  gimballing  utilizes  reaction 
wheels.  The  gimbal  torque  motor  actuators  are  elements  in  the  and  Q2 
blocks  in  Figure  7.  The  torque  motor  elements  of  can  be  considered  to  be 
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Laplace  transform  transfer  functions  to  account  for  dynamical  effects  of  the 
torque  motors  if  necessary.  The  spacecraft  reaction  wheels  (not  their 
housings)  are  actually  additional  bodies  in  the  multi-body  system  and  should 
be  modelled  like  the  other  bodies.  However,  a  simplification  is  justified  if 
the  reaction  wheel  momentum  is  small  enough  that  it  does  not  cause  significant 
gyroscopic  effects  on  the  system.  In  this  case,  the  reaction  wheels  can  be 
considered  to  be  devices  which  apply  torque  to  the  spacecraft  through  the 
dynamics  of  the  wheel  motor  drive  without  the  need  to  consider  the  effects  of 
wheel  speed  on  the  system  momentum.  The  wheels  as  torque  generating  devices 
are  depicted  in  block  of  Figure  7 .  The  elements  of  the  matrix  may  be 
dynamics  transfer  functions. 

6.6  COMPENSATION 

The  blocks  labelled  contain  position  control  loop  compensation 
transfer  functions  and  the  blocks  labelled  contain  the  rate  control  loop 
compensation  transfer  functions.  In  the  case  of  the  experiment,  the 
<t>  and  0  pointing  position  commands  as  well  as  the  and  rate  commands 
are  generated  external  to  the  control  loops.  Switchover  from  position  to  rate 
control  is  done  to  provide  better  tracking  performance  because  of  lower  noise 
and  higher  loop  bandwidth  using  the  rate  loop  only.  The  usual  proportional 
plus  Integral  or  proportional  plus  rate  compensation  is  employed  in  the 
various  compensators.  The  simplified  diagram  in  Figure  7,  for  example,  shows 
the  solar  array  control  without  gyros  or  tachometer  feedback  and  so 
proportional  plus  rate  type  compensation  is  used  for  this  control  loop. 


7 .  SUMMARY 


The  equations  of  motion  of  a  multi-body  gimbal  servo  system  for 
simulation  purposes  were  derived  using  a  simplistic  glmballed  body  momentum 
formulation  that  was  maintained  throughout,  thereby  retaining  the  original 
variables  defined  in  the  beginning  of  the  model  formulation.  The  avoidance  of 
unnecessary  algebraic  manipulation  and  the  introduction  of  new  variables 
through  transformation  of  the  original  variables  is  seen  as  a  simplification 
in  evolving  and  understanding  a  complex  computer  simulation  model  that  can  be 
debugged  and  run  with  enhanced  insight  to  the  physical  process  being 
simulated. 


One  of  the  features  that  helped  in  this  goal  was  the  choice  of  writing 

the  equations  of  rotational  motion  in  the  body  fixed  coordinates  of  the 

glmballed  bodies.  The  result  if  the  simple  body  rotational  dynamics  equation 

■*  -► 

diagram  of  Figure  2.  The  r^x  MR^  moment  of  momentum  term  that  is  added  to  the 
body  rotational  angular  momentum  is  determined  algebraically  by  evaluating  the 
gimbal  interbody  forces  and  utilizing  conservation  of  translational  momentum 
in  order  to  avoid  solution  of  the  translational  dynamics.  Although  somewhat 
involved,  this  process  seems  to  evolve  to  solutions  that  are  straightforward 
as  indicated  by  Figure  4. 


The  equations  of  rotational  motion  are  expressed  in  the  glmballed  body 
coordinates  and  thereby  require  fairly  extensive  transformation  of  angular 
rates  and  torques  from  adjacent  bodies,  but  this  is  true  of  other  formulation 
approaches.  When  a  generalized  coordinate  approach  to  formulation  is  taken, 
the  coordinate  transformations  are  hidden  or  essentially  replaced  by  velocity 
and  momentum  transformations.  Thus,  in  this  regard,  there  appears  to  be  no 
great  disadvantage  in  the  approach  taken  in  this  paper.  However,  there  seems 
to  be  an  advantage  in  keeping  the  avenues  of  insight  open  by  retaining  the 
original  coordinate  transformations  throughout. 

The  equations  necessary  for  the  simulation  of  a  4-body  system  were 
presented  in  matrix-scalar  block  diagram  form  in  Figures  4  and  7.  The 
elements  of  the  3  *  3  matrices  or  dyadics  need  to  be  defined  whereby  it  will 
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be  found  that  many  are  zero  and  many  are  Laplace  transform  transfer 
functions.  The  component  scalar  equations  are  too  detailed  to  devote 
additional  attention  in  this  report. 
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APPENDIX  A 


1.  SCALARIZING 

The  vector  equations  in  this  paper  are  used  in  vector-dyadic  form  until 

the  need  arises  to  scalarize  into  matrix-scalar  forms.  For  computer  time 

history  simulations,  we  need  the  matrix-scalar  form  as  an  end  product  to  work 

from  and  the  block  diagrams  used  herein  are  in  that  form.  In  scalarizing,  the 

*► 

assumption  is  made  that  a  vector  R  can  be  written  in  terms  of  its  components 
along  some  bases  iiAx,  "u^y,  ^Az'  *n  vector  f°rm» 


*►  —  /V  A  A  A 

R  38  R.u.  =  R.  u.  +  R.  u.  +  R.  u. 

A  A  Ax  Ax  Ay  Ay  Az  Az 


(A-l) 


Then  alternatively  in  matrix-vector  form 


{R  > 
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[RAx»  V  RAz1{\x*  %*  “Az}1 


(A-2) 

(A-3) 


RAx"Ax 

RAy% 

RAzuAz 
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or  in  terms  of  its  scalar  components  in  frame  A  the  matrix-scalar  form  is 


ra  -  rV  “ 


Ax 


Ay 
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(A-5) 
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The  idea  of  a  matrix  such  as  the  component  matrix  [R^]  operating  on 

|Ga  j  producing  a  "transformed"  vector  |r^J  i®  applied  to  coordinate 

transformations  where  a  rotation  matrix  [C®]  operating  on  a  vector 
^  ^  A 

say  SA  produces  a  vector  Sfi.  In  "matrix  vector"  form, 

(s,)  -  tcj]  (SA) 


or 


and  in  matrix-scalar  form 


fSB]  -  [C“]  [SA] 


or 


S 


B 


K' s 


A 


SBx 

r_B, 

*  |CA> 

'SAx‘ 

SBy 

SAy 

s 

s. 

Bz 

Az 

The  vector  dyadic  form 


vector 


(A-6) 


(A-7) 


(A-8) 


(A-9) 


(A-10) 


(A-ll) 
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1 


is  represented  in  matrix  scalar  form  as 


s_  -  c®  •  s. 

D  A  A 


(A-12) 


where  the  dyadic  and  matrix  C;  are  equivalent. 

A 

The  vector  R  in  (A-l)  and  (A-3)  did  not  have  to  be  identified  with 
respect  to  a  coordinate  frame  until  its  components  needed  to  be  known,  at 
which  time  its  bases  “AZ  ^ave  t0  specified.  In  the  case  of  the 

coordinate  transformation,  (A-6),  the  bases  of  S  were  presumably  known  to  be 

TJ 

in  frame  A  before  the  transformation  matrix  or  dyadic  CA  could  be  generated  to 
produce  that  vector's  components  in  the  B  frame.  In  this  sense,  the  "matrix 
vector"  form  is  already  in  a  scalarized  form  by  identifying  the  A  and  B  frame 
bases  vectors. 


2. 


DERIVATIVES 


If  a  vector  derivative  operation  is  required  in  a  fixed  inertial  frame 
with  bases  uAx,  uAy,  uAz,  the  components  of  R  are  identified  from 


♦  —  A  •  A  •  A  •  /\ 

R  *  R.u.  »  R.  u.  +  R.  u.  +  R.  u. 

A  A  Ax  Ax  Ay  Ay  Az  Az 


(A-13) 


wherein  the  scalar  components  are  seen  to  be 


(A-l 4) 


If  the  components  of  a  vector  derivative  of  R  are  known  in  a  frame  B 
rotating  at  an  inertial  angular  rate  u  with  respect  to  an  inertial  frame  A, 
the  components  of  the  vector  derivative  in  the  inertial  frame  can  be  found 
from  the  vector  formula 

•  •  • 

*A  “  +  *  *B  (A-l 5) 
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They  are  the  corresponding  quantities  of  the  matrix  scalar  equation 


*A  "  S  +  “b  X  *B  (A-16> 

where  the  symbols  «*  denotes  a  3  *  3  skew-synanetric  matrix  operator  that 
operates  on  the  1  x  3  column  matrix  R  i.e.. 


0)  x 

B 


By 


w 


Bz 


-UJ. 


Bx 


-w_ 


By 


Bx 


(A-17) 


Sometimes  the  components  of  a  vector  derivative  R  (or  any  vector  for  that 

matter)  are  known  in  an  inertial  frame  A  and  it  is  desired  to  determine  its 

components  in  another  frame  B  which  may  be  rotating  or  not.  Here,  the 
* 

components  of  R  in  the  frame  B  are  [see  (A-12)] 

V  5  • 

It  perhaps  should  be  pointed  out  that  u>  in  (A-15)  is  the  inertial  angular 
velocity  of  the  B  frame  whose  components,  if  need  be,  can  be  transformed  via 
formula  (A-12) 


"»  ■  5“  •  “a 

All  of  the  vectors  on  the  right  side  of  (12)  are  thereby  scalarized  in  (17)  to 
the  same  reference  frame.  Note  that  if  there  is  more  than  one  subscript  to  a 
scalar  1  *  3  matrix,  the  last  subscript  denotes  the  reference  frame, 

—  4 

e.g.,  ^23  indicates  the  scalar  coiqionents  of  are  in  fr®®«  3* 


i 

if 
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3 


TRANSFORMATIONS 


B  sU 

The  transformation  matrix  [C“|  or  dyadic  C can  be  a  single  or  multiple 
axis  Euler  angle  transformation.  Here,  for  single  Euler  angle  rotation 
transformations, 

1  0 
0  C$ 

0  -S<J> 


which  is  a  $  rotation  about  XA  axis  in  the  sequence  to  get  to  B  frame. 


(A-21) 


is  a  6  rotation  about  YA  axis  in  the  sequence  to  get  to  B  frame,  and 


(A-22) 


is  a  t  rotation  about  ZA  axis  in  the  sequence  to  get  to  the  B  frame,  where  XA, 
Ya,  Za  are  the  axes  of  the  GA  frame.  If  a  gimbal  axis  set,  through  which 
gimbal  Euler  angles  occur,  has  zero  or  negligible  mass  and  Inertia,  and  are 
intersecting,  then  the  transformation  (1*5)  can  be  taken  as  the  product  of 
successive  rotational  transformations  of  the  massless  gimbal  set.  For 
example,  if  the  massless  gimbal  set  order  of  rotation  is,  first  about  XA, 
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second  about  Y^,  and  third  about  Z^,  then  to  get  from  the  frame  to  the  Gg 
gimbal  frame, 

3  •  t  •  t  <*-«> 

In  the  usual  case  where  a  gimbal  has  appreciable  or  finite  mass,  and  a  single 
bearing  axis  is  employed  which  may  be  non-intersecting  with  other  gimbals, 
then  that  gimbal  should  be  considered  as  a  separate  body  and  a  single  angle 
rotation  (about  the  gimbal  axis)  transformation  is  deemed  adequate.  However, 
strictly  speaking,  the  small  angle  rotations  about  the  axes  transverse  to  the 
bearing  axis  which  can  be  considered  co-centered  should  be  included  in  the 
general  3-axis  case  as  in  Equation  (A-23). 

4.  ATTITUDE  KINEMATICS 

The  gimbal  or  body  angles  or  parameters  that  characterize  the  attitude 
of  the  body  are  computationally  obtained  from  kinematics  rate  equations.  In 
the  case  of  Euler  angles  that  are  used  in  this  paper  they  are  obtained  by 
integration  of  kinematic  rate  equations  typically  of  the  form 


(A-24) 


Where  the  order  of  Euler  angle  rotation  here  is  yaw-pitch-roll  (i.e.,  1st 
about  Z,  2nd  about  Y,  3rd  about  X).  The  coefficient  matrix  is  non-orthogonal 
for  Euler  angle  transformations  and  possesses  singularities.  The  singularity 
condition  is  avoided  for  small  angle  rotations  transverse  to  the  gimbal  axis 
if  the  first  rotation  in  the  sequence  is  taken  to  be  the  gimbal  bearing 
axis.  Also,  the  coefficient  matrix  is  then  independent  of  the  bearing  axis 
Euler  angle.  Thus,  if  small  angle  approximations  for  pitch,  0,  and 
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roll,  are  used,  which  represents  the  small  angular  deflections  transverse 
to  the  bearing  Z  axis,  we  get  for  the  above  example. 


♦ 

0 


(A-25) 


where,  again,  it  is  seen  that  the  coefficient  matrix  does  not  contain  the 
bearing  axis  rotation  angle,  ty. 

It  may  easily  be  ascertained  that  the  small  angle  approximation  for  the 
coefficient  matrix  is  not  unique  and  independent  of  the  order  of  the  last  two 
rotations,  i.e.,  pitch-roll  vs.  roll-pitch.  This  observation  and  the 
assumption  that  the  transverse  axis  rotations  will  be  truly  small  and 
oscillatory,  are  motivations  for  setting  the  small  angles  in  the  coefficient 
matrix  to  zero.  The  coefficient  matrix  is  then  seen  to  be  the  Identity 
matrix. 

The  spacecraft  attitude  errors  are  obtained  in  a  similar  fashion, 
however  the  attitude  errors  are  referenced  to  the  local  orbit  frame.  Thus, 
the  attitude  kinematic  rate  equations  are  of  the  form  of  equation  (A-24) 
except  the  rate  error  vector  on  the  right  side  of  equation  (A-24)  is 

Aoi  ■  u>3  -  «0  (A-26) 

which  is  reflected  in  Figure  7  as  the  spacecraft  attitude  error  rate. 
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